#include <board.h>
#include <drv_common.h>

#ifdef RT_USING_SERIAL
#include <drv_usart.h>
#endif

#ifdef RT_USING_FINSH
#include <finsh.h>
static void reboot(uint8_t argc, char **argv)
{
	rt_hw_cpu_reset();
}
MSH_CMD_EXPORT(reboot, Reboot System);
#endif /* RT_USING_FINSH */

/* SysTick configuration */
void rt_hw_systick_init(void)
{
	SysTick_Config(SystemCoreClock / RT_TICK_PER_SECOND);
	systick_clksource_set(SYSTICK_CLKSOURCE_HCLK);
	NVIC_SetPriority(SysTick_IRQn, 0XFF);
}

/**
 * This is the timer interrupt service routine.
 *
 */
void SysTick_Handler(void)
{
	/* enter interrupt */
	rt_interrupt_enter();

	rt_tick_increase();

	/* leave interrupt */
	rt_interrupt_leave();
}

uint32_t HAL_GetTick(void)
{
	return rt_tick_get_millisecond();
}

void HAL_SuspendTick(void)
{
}

void HAL_ResumeTick(void)
{
}

void HAL_Delay(__IO uint32_t Delay)
{
	if (rt_thread_self())
	{
		rt_thread_mdelay(Delay);
	}
	else
	{
		for (rt_uint32_t count = 0; count < Delay; count++)
		{
			rt_hw_us_delay(1000);
		}
	}
}

///* re-implement tick interface for STM32 HAL */
// HAL_StatusTypeDef HAL_InitTick(uint32_t TickPriority)
//{
//     /* Return function status */
//     return HAL_OK;
// }

/**
 * @brief  This function is executed in case of error occurrence.
 * @param  None
 * @retval None
 */
void _Error_Handler(char *s, int num)
{
	/* USER CODE BEGIN Error_Handler */
	/* User can add his own implementation to report the HAL error return state */
	while (1)
	{
	}
	/* USER CODE END Error_Handler */
}

/**
 * This function will delay for some us.
 *
 * @param us the delay time of us
 */
void rt_hw_us_delay(rt_uint32_t us)
{
	rt_uint32_t start, now, delta, reload, us_tick;
	start = SysTick->VAL;
	reload = SysTick->LOAD;
	us_tick = SystemCoreClock / 1000000UL;
	do
	{
		now = SysTick->VAL;
		delta = start >= now ? start - now : reload + start - now;
	} while (delta < us_tick * us);
}

/**
 * This function will initial STM32 board.
 */
void hw_board_init(char *clock_src, int32_t clock_src_freq,
				   int32_t clock_target_freq)
{
	extern void clk_init(char *clk_source, int source_freq, int target_freq);

#ifdef SCB_EnableICache
	/* Enable I-Cache---------------------------------------------------------*/
	SCB_EnableICache();
#endif

#ifdef SCB_EnableDCache
	/* Enable D-Cache---------------------------------------------------------*/
	SCB_EnableDCache();
#endif

	/* enable interrupt */
	__set_PRIMASK(0);
	/* System clock initialization */
	clk_init(clock_src, clock_src_freq, clock_target_freq);
	/* disable interrupt */
	__set_PRIMASK(1);

	rt_hw_systick_init();

	/* Pin driver initialization is open by default */
#ifdef RT_USING_PIN
	extern int rt_hw_pin_init(void);
	rt_hw_pin_init();
#endif

	/* USART driver initialization is open by default */
#ifdef RT_USING_SERIAL
	extern int rt_hw_usart_init(void);
	rt_hw_usart_init();
#endif
}
